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@ Verfahren und Vorrichtung zur Regelung der Vorhalteposition eines Manipulators eines Handhabungsgerats 

@ Die Erfindung betrlfft ein Verfahren zur Regelung der 
Vorhalteposition eines in mehreren Freiheitsgraden be- 
wegbaren Manipulators (2) eines Handhabungsgerats (1) 
relativzu einem Objekt (3) entlang einer Verfahrbahn. Um 
eine schnetlere Regelung der Vorhalteposition zu ermog- 
lichen, wird vorgeschlagen, dass mehrero Punkte zumin- 
dest eines Teils der Ist-Verfahrbahn gespetchert sind und 
fur eine vorausschauende Regelung der Vorhalteposition 
des Manipulators (2) entlang dieses Teils der Verfahrbahn 
herangezogen werden. 
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Beschreibung 



Die vorliegende Erfindung betrifft. ein Verfahren und eine 
Vorrichtung zur Regelung der Vorhaiteposition eines in 
mehreren Freiheitsgraden bewegbaren Manipulators eines 
Handhabungsgerats relativ zu eineni Objekt endang einer 
Verfahrbahn. Die Erfindung betrifft auBerdem ein Handha- 
bungsgerat mit einem in mehreren Freiheitsgraden beweg- 
baren Manipulator, dessen Vorhaiteposition relativ zu einem 
Objekt regelbar ist. 

Das Handhabungsgerat ist bspw. als ein mehrgelenkiger 
Industrie-Roboter ausgebildet. Derartige Industrie-Roboter 
werden insbesondere in der Automobilindustrie in der Ferti- 
gung und der Qualitatssicherung eingesetzt. Fur die unter- 
schiedlichen Einsatzmoglichkeiten eines Industrie-Roboters 
kann der Manipulator beliebig ausgebildet sein. 

Der Manipulator ist bspw. als ein Werkzeug, insbesondere 
als ein SchwetBgerat, als ein Gerat zum Auftragen von 
Klebstoff, von Farbe oder von anderen Beschichtungen auf 
eine Oberflache, als ein Bearbeitungsgerat o. a. ausgebildet. 
Zum Ergrcifen eines oder mehrerer Objekte kann der Mani- 
pulator als ein Greifer, ein Saugnapf o. a. ausgebildet sein. 
Schliefilich ist es denkbar, dass der Manipulator als ein 
Messkopf z. B. zum Messen des Oberflachenverlaufs eines 
Objekts, einer Spaltbreite, eines Spaltversatzes. einer 
Schichtdicke o. a. ausgebildet ist. 

Damit der Manipulator die ihm zugedachte Aufgabe er- 
fullen kann, muss er in eine definierte Vorhaiteposition rela- 
tiv zu einem Objekt gebracht werden. Unter dem Begriff 
Vorhaiteposition wird gemaB dem vorliegenden Patent so- 
wohl die Positionierung als auch die Ausrichtung des Mani- 
pulators relativ zu dem Objekt verstanden. 

Aus dem Stand der Technik sind Handhabungsgerate be- 
kannt, die eine interne Steuerungseinrichtung aufweisen. 
Auf der Steuerungseinrichtung ist ein Steuerungsprogramm 
lauffahig, durch das der Manipulator entlang einer program- 
mierten Verfahrbahn in die Vorhaiteposition bewegt werden 
kann. Wenn das Objekt stets an derselben Position angeord- 
net ist, reicht eine solche Steuerung der Verfahrbahn bis zur 
Vorhaiteposition vollkommen aus. Falls die Position des 
Objekts jedoch gewissen Schwankungen unterworfen ist, 
was der Regelfall ist, kann durch eine Steuerung alleine 
nicht mehr sichergestellt werden, dass eine bestimmte Vor- 
haiteposition des Manipulators relativ zu dem Objekt stets 
mit der erforderlichen Genauigkeit eingenoiiimen wird. 
Schwankungen der Position des Objekts konnen vielerlei 
Ursachen haben. 

Urn sicherzustellen, dass die Vorhaiteposition des Mani- 
pulators relativ zu dem Objekt auch bei Schwankungen der 
Position des Objekts stets mit der geforderten Genauigkeit 
eingenommen wird, ist es aus dem Stand der Technik eben- 
falls bekannt, die Vorhaiteposition des Manipulators relativ 
zu dem Objekt zu regeln. Aus dem Stand der Technik sind 
unterschiedliche Verfahren zur Regelung der Vorhaitepos- 
ition des Manipulators bekannt. Diese bekannten Verfahren 
zur Regelung der Vorhaiteposition sind jedoch sehr kompli- 
ziert und langsam. 

Im Rahmen der Regelung der Vorhaiteposition des Mani- 
pulators relativ zu einem Objekt wird die Ist- Vorhaitepos- 
ition des Manipulators zunachst mittels Sensoren erf asst und 
dann auf eine Soli- Vorhaiteposition geregelt. Die Sensoren 
sind bspw. als optische oder als taktile Sensoren ausgebildet. 

Insbesondere sind sie als Laser-Sensoren zum Messen 
von Abstanden, als Kraft/Momenten-Sensoren zum Messen 
von Kraften bzw. Momenten oder als Beruhrungssensoren 
zur Detektion einer Beruhrung mit dem Objekt ausgebildet. 

Die Sensoren sind in einem bestimmten Bezug (Position 
und Ausrichtung) zu dem Manipulator angeordnet. Vor der 



Regelung der Vorhaiteposition mussen die Sensoren in ei- 
ncn konkrcten Bezug zu dem Manipulator und zu dem Ob- 
jekt gebracht werden (Binrichten) und die Parameter dor Re- 
gelung an den konkreten Bezug angepasst werden (Kalibrie- 
5 ren). Der Bezug der Sensoren zu dem Manipulator kann sich 
aufgrund von Temperaturschwankungen, mechanischen 
Einwirkungen auf die Sensoren oder den Manipulator, o. a. 
verandern, wodurch ein emeutes Kalibrieren und u. U. sogar 
eine emeutes Binrichten der Vorrichtung zur Durchfuhrung 
10 der Regelung notwendig wird. Wahrcnd des Einrichtens und 
Kalibrierens steht die Vorrichtung nicht fur eine Regelung 
zur Verfiigung, die Regelung der Vorhaiteposition muss un- 
terbrochen werden. 

Samtliche bekannten Verfahren zur Regelung der Vorhalt- 
15 eposition des Manipulators haben auBerdem den Nachteil, 
dass die Verfahrgeschwindigkeit des Manipulators relativ 
klein ist, da die Regelung in Unkenntnis der bevorstehen- 
den, zu regelnden Verfahrbahn des Manipulators erfolgl. 
Deshalb muss die Verfahrgeschwindigkeit so klein gewahlt 
2D werden, dass auch im Extremfall einer Verfahrrichtungsum- 
kehr eine rasche und genau Positionierung des Manipulators 
sichergestellt werden kann. Bei einer zu hohen Verfahrge- 
schwindigkeit wurde der Manipulator bei stark gekrummten 
Verfahrbahnen oder einer Verfahrrichtungsumkehr aufgrund 
25 der Massentragheit uber die geregelte Verfahrbahn hinaus- 
schieBen und somit die geregelte Verfahrbahn verlassen. 

Es ist deshalb eine Aufgabe der vorliegenden Erfindung, 
ein V^ahren der eingangs genannten Art dahingehend aus- 
zugestalten und weiterzubilden, dass eine moglichst 
30 schnelle Regelung der Vorhaiteposition erreicht und dass 
insbesondere hohere Verfahrgeschwindigkeiten des Mani- 
pulators auf der Verfahrbahn realisiert werden konnen, ohne 
dass es zu einem Verlust an Regelungsgenauigkeit kommt. 
Zur Losung dieser Aufgabe schlagt die Erfindung ausge- 
35 hend von dem Verfahren der eingangs genannten Art vor, 
dass mehrere Punkte zumindest eines Teils der Ist- Verfahr- 
bahn gespeichert sind und fur eine vorausschauende Rege- 
lung der Vorhaiteposition des Manipulators entlang dieses 
Teils der Verfahrbahn herangezogen werden. 
40 ErfindungsgemaB ist erkannt worden, dass die Regelung 
der Voilialteposition durch eine vorausschauende Regelung 
auf einfache Weise entscheidend beschleunigt werden kann. 
Wahrend der vorausschauenden Regelung der Vorhaitepos- 
ition wird der bevorstehende Verlauf der Verfahrbahn be- 
45 riicksichtigt. Wenn der bevorstehende Verlauf der Verfahr- 
bahn es zulasst, bspw. bei einer geraden oder einer nur ge- 
ringfiigig gekrummten Verfahrbahn, kann die Verfahrge- 
schwindigkeit des Manipulators hoch gewahlt werden. Da- 
durch kann die Regelung der Vorhaiteposition enUang einer 
50 Verfahrbahn entscheidend beschleunigt werden. Bei zuneh- 
mender Knimmung der bevorstehenden Verfahrbahn muss 
die Verfahrgeschwindigkeit zunehmend reduziert werden. 
Durch die Wahl einer geringen Verfahrgeschwindigkeit bei 
starken Kriimmungen der bevorstehenden Verfahrbahn kann 
55 zudem die Genauigkeit der Regelung der Vorhaiteposition 
des Manipulators endang der Verfahrbahn entscheidend er- 
hoht werden. Bei dem erfindungsgemaBen Verfahren kann 
die Verfahrgeschwindigkeit somit dem Verlauf der bevorste- 
henden Verfahrbahn individuell angepasst werden. 
60 Die Punkte der Ist- Verfahrbahn konnen auf unterschiedli- 
che Weise, z. B. empirisch, simulativ oder durch Berech- 
nung, bestimmt werden. Bei der empirischen Bestimmung 
der Punkte der Ist- Verfahrbahn konnen die einzelnen Punkte 
entweder mit dem Manipulator des Handhabungsgerats ma- 
65 nuell Oder von einer ersten Steuereinrichtung gesteuert an- 
gefahren werden. Bei der simulativen Besdmmung der 
Punkte wird zunachst ein Modell des Handhabungsgerats 
und des Objekts, vorzugsweise auf einem Computer, er- 
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stellt. Anhand dieses Modells wird dann durch Simulation 
der Verfahrbahn die Isl-Vcrfahrbahn besLiixiiiiL Bci der ma- 
thematischen Berechnung der Punkte der Tst- Verfahrbahn 
wird zunachst ein mathematisches Modell des Handha- 
bungsgerals und des Objekts erstelll, und die Punkte werden 
dann durch Losen mathematischer Gleichungen berechnet. 

GemaB einer vorieilhaften Weilerbildung der vorliegen- 
den Erfindung wird vorgeschlagen, dass die 1st- Verfahrbahn 
des Manipulators vor der Regelung der Vorhalteposition ab- 
gefahren wird und dabei die I^unkte zumindest eines Teils 
der 1st- Verfahrbahn aufgenonimen und abgespeichert wer- 
den. Die 1st- Verfahrbahn muss nicht mit besonders hohen 
Anforderungen an die Genauigkeit abgefahren werden, da 
die Verfahrbahn im Rahmen der nachfolgenden Regelung 
der Verfahrbahn des Manipulators korrigiert werden kann. 
Die abgefahrene 1st- Verfahrbahn stellt ledighch eine Ab- 
schatzung des Verlaufs der Soil- Verfahrbahn dar und muss 
so genau sein, dass sie fur eine vorausschauende Regelung 
der Vorhalteposition des Manipulators endang der Verfahr- 
bahn herangezogen werden kann. 

Die 1st- Verfahrbahn wird vorteilhafterweise von dem Ma- 
nipulator vor der Regelung der Vorhalteposition von einer 
internen Steuerungseinrichtung des Handhabungsgerats ge- 
steuert abgefahren. Auf der internen Steuerungseinrichtung 
lauft ein Steuerungsprogramm ab, in dem die einzelnen 
Punkte der 1st- Verfahrbahn programmiert sind. Das Steue- 
rungsprogramm steuert das Handhabungsgerat derart an, 
dass der Manipulator wahrend des Ablaufs des Steuerungs- 
progranuns die 1st- Verfahrbahn abfahrt. Dabei werden die 
Punkte zumindest eines Teils der 1st- Verfahrbahn aufge- 
nommen und abgespeichert. AuBer den in dem Steuerungs- 
programm programmierten Punkten der 1st- Verfahrbahn 
konnen noch zusatzliche Punkte der 1st- Verfahrbahn aufge- 
nonunen und gespeichert werden. 

Die Punkte zumindest eines Teils der 1st- Verfahrbahn 
werden vorzugsweise von einer extemen Regelungseinrich- 
tung aufgenommen und abgespeichert. Auf der extemen Re- 
gelungseinrichtung lauft ein Regelungsprogramm ab, das 
die Vorhalteposition des Manipulators auf der Verfahrbahn 
regelt. Die exteme Regelungseinrichtung ist bspw. als ein 
Personal Computer (PC) oder als ein Industrie- PC ausgebil- 
det. Das Regelungsprogramm kann in einer Standard-IVo- 
grammiersprache programmiert und ohne groBen Aufwand 
umprogrammiert werden. In einera bestimmten Modus (Re- 
cord-Mode) vor der Regelung der Vorhalteposition kann das 
Regelungsprogramm auch die Punkte der von dem Manipu- 
lator abgefahrenen Ist- Verfahrbahn aufnehmen und abspei- 
chem. Die gespeicherten Punkte werden dann in einem an- 
deren Modus (Operation-Mode) fur die vorausschauende 
Regelung der Vorhalteposition herangezogen. 

GemaB einer anderen vorteilhaften Weiterbildung der 
vorliegenden Erfindung wird vorgeschlagen, dass die ex- 
teme Regelungseinrichtung von der internen Steuerungsein- 
richtung aufgerufen wird. Das Steuerungsprogramm der in- 
ternen Steuerungseinrichtung ist iiblicherweise in einer pro- 
prietaren, nur auf der Steuerungseinrichtung eines bestimm- 
ten Handhabungsgerats laulfahigen Programmierungsspra- 
che programmiert. Es wSre nur mit einem groBen Aufwand 
mdglich, das gesamte Regelungsprogramm in das Steue- 
rungsprogramm zu integrieren. Deshalb sind in dem Steue- 
rungsprogramm bestimmte Programmierbefehle (Aufrufbe- 
fehle, Ruckholbefehle) vorgesehen, um das Regelungspro- 
granun der extemen Regelungseinrichtung von dem Steue- 
mngsprogramm aus aufzurufen. Das Einfiigen dieser Pro- 
grammierbefehle in das Steuerungsprogranun ist mit einem 
geringen Aufwand moglich. Je nach dem in welchem Mo- 
dus die Regelung betrieben wird, werden durch einen Auf- 
ruf des Regelungsprogranuns der Regelungseinrichtung die 



Punkte der Ist- Verfahrbahn aufgenommen und gespeichert 
(Record-Mode) oder die Vorhalteposition vorausschaucnd 
geregelt (Operation-Mode). 

In einer anderen vorteilhaften Weiterbildung der Erfin- 
5 dung wird vorgeschlagen, dass vor der Regelung der Vor- 
halteposition die Soli- Vorhalteposition des Manipulators an- 
gefahren wird, wahrend einer Veranderung der Soil- Vorhalt- 
eposition um jeweils einen Freiheitsgrad Messdaten, durch 
die die Vorhalteposition des Manipulators charakterisiert ist, 

10 aufgenonimen und gespeichert werden und die Regelung 
der Vorhalteposition in Abhangigkeit von den Messdaten 
durchgeflihrt wird. Zwischen den aufgenommenen Messda- 
ten und der Position des Manipulators besteht ein Zusam- 
menhang. Somit sind in den aufgenommenen Messdaten Tn- 

15 formationen iiber die Position des Manipulators enthalten. 
Die Soil- Vorhalteposition wird in einem weiteren Modus 
(Parameter-Mode) vor der Regelung der Vorhaltcposiuon 
angefahren. Zum Anfahren der Soli- Vorhalteposition im Pa- 
rameter-Mode werden die im Record-Mode gespeicheiten 

20 Punkte der Ist- Verfahrbahn herangezogen. Sobald die SoU- 
Vorhalteposition erreicht ist, beginnt eine TVainingsphase, in 
der fur die spatere, im Rahmen des Operation-Mode durch- 
gefuhrte Regelung der Vorhalteposition benotigte Informa- 
tionen ermittelt werden. 

25 Wahrend der Trainingsphase wird der Manipulator um 
die Soil- Vorhalteposition um jeweils einen Freiheitsgrad in 
unterschiedliche Vorhaltepositionen relativ zu dem Objekt 
bewegt. Der Manipulator wird um jeden Freiheitsgrad in 
Vorhaltepositionen bewegt, die vorzugsweise zu beiden Sei- 

30 ten der Soli- Vorhalteposition liegen. Die Vorhaltepositionen 
des Manipulators werden durch Sensoren ermittelt, die vor- 
zugsweise an dem Manipulator befesdgt sind. Die Sensoren 
liefem Messdaten anhand derer eine Voriialteposition des 
Manipulators charakterisiert ist. Die Messdaten sind bspw. 

3S die Abst&ide von den Sensoren zu dem Objekt, Krafte oder 
Momente, die von dem Objekt auf die Sensoren einwirkra. 
Die Messdaten konnen auch Bildmessdaten sein. Bildmess- 
daten werden durch Vermessen von Bildem gewonnen, die 
von einer CCD-Kamera o. a. aufgenommen wurden. Im 

40 Rahmen der Trainingsphase werden die Messdaten fur jeden 
der Freiheitsgrade fur jede der Vorhaltepositionen aufge- 
nommen. Es ist denkbar, dass die gespeicherten Messdaten 
fiir die Regelung der Vorhalteposition weiterverarbeitet wer- 
den. Dann ist die Trainingsphase fiir diese Soll-Vorhaltepos- 

45 ition abgeschlossen. Der Manipulator kann eine weitere 
Soil- Vorhalteposition anfahren und fiir diese Soil- Vorhalt- 
eposition eine weitere Trainingsphase durchlaufen, bis aUe 
Soil- Vorhaltepositionen angefahren worden sind. Dann ist 
der Parameter-Mode abgeschlossen. Die spatere, im Rah- 

50 men des Operation-Mode durchgefiihrte Regelung der Vor- 
halteposition wird in Abhangigkeit von den gespeicherten 
Messdaten durchgeflihrt. 

Bei dem erfindungsgemaBen Verfahren ersetzt die Trai- 
ningsphase das bei herkommlichen, aus dem Stand der 

55 Technik bekannten Verfahren zum Regeln der Vorhaltepos- 
idon des Manipulators eines Handhabungsgerats notwen- 
dige Einrichten (Positionierung der Sensoren relativ zu dem 
Objekt) und Kalibrieren (Einstellen der Parameter der Rege- 
lung). 

60 Auch bei diesem Verfahren, bei dem vor der Regelung der 
Vorhalteposition eine Trainingsphase durchlaufen wird, 
werden mehrere Punkte zumindest eines Teils der Ist- Ver- 
fahrbahn gespeichert und fur eine vorausschauende Rege- 
lung der Vorhalteposition des Manipulators entlang dieses 

65 Teils der Verfahrbahn herangezogen. Das Durchlaufen einer 
Trainingsphase vor der Regelung der Vorhalteposition hat 
die angegebencn Vorteile aber auch ohne diese Merkmale 
des Kennzeichens des Patentanspruchs 1. Der Schutz des 
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Patents soli sich deshalb auch auf ein Verfahren der zuletzl 
gcnanntcn Art bezichcn, bd dein die iin Kennzeichcn dcs 
Paten tanspruchs 1 genannten Merkmale fehlen. 

GemaB einer bevorzugten Ausfuhrungsfonn der vorlie- 
genden Erfindung wird vorgeschlagen, dass vor der Rege- 
lung der Vorhalteposition 

- die Soli- Vorhalteposition angefahren wird, 

- ein SoU-Messvektor mit den Messdaten aufgenom- 
men wird, 

- fiir jeden Freiheitsgrad der Manipulator des Handha- 
bungsgerats aus der Soli- Vorhalteposition heraus in 
mehrere Vorhaltepositioncn bewegt und in jeder Vor- 
halteposition ein Messvektor aufgenommen wird, 

- fur jeden Freiheitsgrad fiir dieselben Messdaten der 
Messvektoren der Betrag des Gradienten ermittelt und 
in einer Gradientcnmatrix gespeichert wird, und im 
Rahmen der Regelung der Vorhalteposition 

- ein Korrekturvektor aus der Multiplikation des 
Kehrwerts der Gradientenmatrix mit der Differenz des 
Soll-Messvektors und eines Ist-Messvektors in der 1st- 
Vorhalteposition des Manipulators oder anhand eines 
anderen geeigneten Verfahrens ermittelt wird und 

- die Vorhalteposition in Abhangigkeit von dem Kor- 
rekturvektor geregelt wird. 

GemaB dieser bevorzugten Ausfuhrungsfonn werden in 
der TVainingsphase im Parameter-Mode die fiir die Soll-Vor- 
halteposition aufgenommenen Messdaten in einem Soll- 
Messvektor und die Messdaten, die fiir im Rahmen der TVai- 
ningsphase angefahrene Vorhaltepositioncn aufgenommen 
wurden, in Messvektoren gespeichert, Fiir jeden Freiheits- 
grad, um den der Manipulator bewegbar ist, werden also von 
der Soil- Vorhalteposition aus mehrere Vorhaltepositionen in 
jede Richtung angefahren und in jeder Vorhalteposition ein 
Messvektor aufgenommen. Die Dimension der Messvekto- 
ren entspricht der Anzahl der fiir jede Vorhalteposition auf- 
genommenen Messdaten. Die Dimension aller Messvekto- 
ren ist gleich groB. 

Fiir jeden Freiheitsgrad werden die Messvektoren und der 
SoU-Messvektor dann weiterverarbeitet. Aus denselben 
Messdaten der Messvektoren eines Freiheitsgrades wild der 
Betrag des Gradienten ermittelt und in einer Gradientenma- 
trix gespeichert. Die Gradientenmatrix hat somit die Dimen- 
sionen (Anzahl der fur jede Vorhalteposition aufgenoname- 
nen Messdaten) x (Anzahl der Freiheitsgrade). Es ist denk- 
bar, den Kehrwert der Gradientenmatrix bereits in dem Pa- 
rameter-Mode zu berechnen und abzuspeichem. Vorzugs- 
weise wird er aber erst in dem nachfolgenden Operation- 
Mode berechnet. Damit ist die Train ingsphase fiir diese 
Soil- Vorhalteposition abgeschlossen. Die Gradientenmatrix 
kann auch als Jakobimatrix oder als Sensibilitatsmatrix be- 
zeichnet werden. 

Im Rahmen des Operation-Mode wird dann fur die Rege- 
lung der Vorhalteposition des Manipulators ein Ist-Mess- 
vektor ermittelt, d. h. es werden die Messdaten in der mo- 
mentanen Vorhalteposition des Manipulators des Handha- 
bungsgerats ermittelt und in dem Ist-Messvektor gespei- 
chert. Dann wird ein Differenzvektor aus der Differenz des 
Soll-Messvektors und des Ist-Messvektors gebildet. Des 
Weiteren wird der Kehrwert der Gradientenmatrix berechnet 
und wahlweise abgespeichert. 

SchlieBlich wird ein Korrekturvektor aus der Multiplika- 
tion des Kehrwerts der Gradientenmatrix mit dem Diffe- 
renzvektor berechnet und die Vorhalteposition in Abhangig- 
keit von dem Korrekturvektor geregelt. 

Der Korrekturvektor kann auch niittcls eines anderen ge- 
eigneten Verfahrens bestimmt werden, bspw. durch den Ein- 



satz eines sequentiellen Kalmanfilters. Derartige geeignete 
Verfahren zum Berechnen des Korreklurvektors sind aus 
dem Stand der Technik bekannt und konnen von einem 
Fachmann nach Belieben eingesetzt werden. Diese anderen 
5 geeigneten Verfahren haben den Vorteil, dass auf eine relativ 
aufwendige Bildung des Kehrwerts der Gradientenmatrix 
verzichtet werden kann. 

Wahrend des Operation-Mode fahrt der Manipulator zu- 
nachst die Verfahrbahn gemaB den wahrend des Record- 
10 Mode gcspeicherten Punktcn ab. Diese Verfahrbahn wird 
dann im Rahmen der Regelung der Vorhalteposition des Ma- 
nipulators mit Hilfe des Korreklurvektors korrigiert. Bei 
dem erfindungsgeniaBen Verfahren wird die Vorhaltepos- 
ition also nicht absolut, sondem lediglich relativ zu einer 
15 Vorhalteposition auf der gcspeicherten Verfahrbahn gere- 
gelt. 

Vorteilhafterweise wird die Ist- Vorhalteposition im Rah- 
men der Regelung der Vorhalteposition um einen Bruchteil 
des Korreklurvektors korrigiert und anschlieBend der Ist- 
20 Messvektor in der korrigierten Ist- Vorhalteposition und dar- 
aus der Korrekturvektor emeut ermittelt. Die Ist- Vorhalt- 
eposition wird also nicht um den gesamten Korrekturvektor 
korrigiert. Um ein Uberschwingen der Regelung zu verhin- 
dem, wird vielmehr versucht, sich der Soli- Vorhalteposition 
25 langsam von einer Richtung her anzunahem. Dadurch wird 
eine Regelung mit einem gedampften Einschwingverhalten 
realisiert. Durch eine geeignete Wahl des Bruchteils des 
Korreklurvektors kann die DSmpfungskonstante der Rege- 
lung bestimmt werden. 
30 Die Regelung der Vorhalteposition wird vorzugsweise ab- 
gebrochen, wenn jedes der Elemente des Korreklurvektors 
kleiner als ein Abbruchkriterium ist. Durch eine geeignete 
Wahl des Abbruchkriteriums kann einerseits die Genauig- 
k^t der Regelung und andererseits die Regelungsgeschwin- 
35 digkeit bestimmt werden. Je kleiner der Wert des Abbruch- 
kriteriums gewahlt wird, desto genauer kann die Regelung 
der Vorhalteposition durchgefiihrt werden. Ein kleiner Wert 
des Abbruchkriteriums bedeutet jedoch auch, dass die Rege- 
lung mehr Zeit benbtigt, bis das Abbruchkriterium erfiillt 
40 ist. 

Um eine Regelbarkeit der Vorhalteposition des Manipula- 
tors innerhalb eines bestimmten Arbeitsvolumens der Rege- 
lung sicherzustellen, soUten die aufgenommenen Messvek- 
toren nach Moglichkeit das gesamte Arbeitsvolumen abdek- 
45 ken. Des Weiteren soUten fur jeden Freiheitsgrad so viele 
Messvektoren aufgenommen werden, dass eine zuverlassige 
Berechnung des Betrags des Gradienten der Messdaten 
moglich ist. Deshalb wird gemaB einer bevorzugten Ausfuh- 
rungsfonn der Erfindung vorgeschlagen, dass fur jeden Frei- 
50 heitsgrad von der Soil- Vorhalteposition aus mindestens zwei 
Messvektoren in jede Richtung aufgenonmien werden. Vor- 
teilhafterweise werden jedoch fiir jeden Freiheitsgrad von 
der Soil- Vorhalteposition aus fiinf Messvektoren in jede 
Richtung aufgenonmien. Somit ergeben sich fur jeden Frei- 
55 heitsgrad zehn Messvektoren und der SoU-Messvektor, also 
elf Messvektoren. Fiir jedes der aufgenommenen und in den 
Messvektoren gespeicherte Messdatum wird dann der Be- 
trag des Gradienten berechnet und in der Gradientenmatrix 
abgespeichert, 

60 Die Messvektoren mussen zusarmnen fiir jeden Freiheits- 
grad, in dem die Vorhalteposition des Manipulators des 
Handhabungsgeriits geregelt wird, mindestens ein unabhan- 
giges Messdatum enthalten. GemaB einer weiteren bevor- 
zugten Ausfiihrungsfonn der Erfindung wird vorgeschlagen, 
65 dass die Messvektoren zusammen mindestens sechs Mess- 
daten enthalten. Dadurch kann die Position und Ausrichtung 
des Manipulators relativ zu dem Objekt in sechs Freiheits- 
graden eindeutig charakterisiert werden. Damit kann die 
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Vorhaiteposition des Manipulators um sechs Freiheitsgrade 
iin dreidiincnsionalen Rauiii gcregelt wcrdcn. "Nforzugswcisc 
enthaUen die Messvektoren jeweils 32 Messdaten. 

Eine weitere Aufgabe der vorliegenden Erfindung besteht 
darin, eine Vorrichlung der eingangs genannten Art dahinge- 5 
hend auszugestalten und weiterzubilden, dass eine mog- 
lichst schnelle Regelung der Vorhaiteposition erreicht und 
dass insbesondere hohere Verfahrgeschwindigkeiten des 
Manipulators auf der Verfahrbahn realisiert werden konnen, 
ohnc dass es zu cincm Verlust an Regelungsgcnauigkcil lO 
kommt. 

Zur Losung dieser Aufgabe schlagt die Erfindung ausge- 
hend von der VorrichLung der eingangs genannten Art vor, 
dass die Vorrichtung Miltel zur Durchfuhrung des Verfah- 
rens nach einem der Anspriiche 1 bis 13 aufweist. 15 

Eine weitere Aufgabe der vorliegenden Erfindung besteht 
schlieBlich darin, ein Handhabungsgerat der eingangs ge- 
nannten Art dahingehend auszugestalten und weiterzubil- 
den, dass eine moglichst schneUe Regelung der Vorhaitepos- 
ition erreicht und dass insbesondere hohere Verfahrge- 20 
schwindigkeiten des Manipulators auf der Verfahrbahn rea- 
lisiert werden konnen, ohne dass es zu einem \^rlust an Re- 
gelungsgenauigkeit kommt, 

Zur Losung dieser Aufgabe schlagt die Erfindung ausge- 
hend von dem Handhabungsgerat der eingangs genannten 25 
Art vor, dass das Handhabungsgerat Mittel zur Durchfuh- 
rung des Verfahrens nach einem der Anspriiche 1 bis 13 auf- 
weist. 

Die erfindungsgemaBe Vorrichtung und das erfindungsge- 
maBe Handhabungsgerat weisen insbesondere Mittel auf, 30 
um in einem Record-Mode mehrere Punkte zumindest eines 
Teils derlst-Vnfahrbahn zu speichem und die gespeicherten 
Punkte dann in einem Operation-Mode fur eine voraus- 
schauende Regelung der Vorhaiteposition des Manipulators 
entlang dieses Teils der Verfahrbahn heranzuziehen. Des 35 
Weiteren weisen die erfindungsgemaBe Vorrichtung und das 
erfindungsgemaBe Handhabungsgerat Mittel auf, um in ei- 
nem Parameter-Mode im Rahmen einer Trainingsphase den 
Manipulator in eine Soll-Vorhalteposidon zu fahren, um den 
Manipulator um die einzelnen Freih^tsgrade des Handha- 40 
bungsgerats in andere Vorhallepositionen zu verfahren und 
fiir jeden Freiheitsgrad in jeder Vorhaltep>osition die Mess- 
daten aufzunehmen und zu speichem, durch die die entspre- 
chende Vorhaiteposition charakterisiert ist. 

Bei der erfindungsgemaBen Vorrichtung und dem erfin- 45 
dungsgemaBen Handhabungsgerat kann die Verfahrge- 
schwindigkeit des Manipulators aufgrund der vorausschau- 
enden Regelung besonders groB gewahlt werden. AuBerdem 
ersetzL die Trainingsphase das Einrichten und KaHbrieren 
der Sensoren. Mit der erfindungsgemaBen Vorrichtung und 50 
dem erfindungsgemaBen Handhabungsgerat ist somit eine 
schnellere Regelung der Vorhaiteposition mogUch, ohne 
dass es zu einem Verlust an Regelungsgenauigkeit kommt 

GemaB einer vorteilhaften Weiterbildung der vorliegen- 
den Erfindung wird vorgeschlagen, dass an dem Manipula- 55 
tor des Handhabungsgerats zur EnnitQung der Ist- Vorhait- 
eposition des Manipulators relativ zu dem Objekt minde- 
stens ein Sensor befestigt ist. 

Der oder jeder Sensor ist vorteilhafierweise derart relativ 
zu dem Objekt angeordnei, dass die Folge der Messdaten 60 
der fiir einen Freiheitsgrad aufgenommenen Messvektoren 
streng monoton ist. Dies ist eine wichtige Voraussetzung, 
um den Manipulator aus alien Positionen und Ausrichtun- 
gen relativ zu dem Objekt stets in die gewiinschte Soil- Vor- 
haiteposition regeln zu konnen. 65 

Des Weiteren muss die Beobachtbarkeit der Regelung si- 
chergestellt sein. Deshalb wird gemaB einer anderen vorteil- 
haften AusfUhrungsform der Erfindung vorgeschlagen, dass 



der oder jeder Sensor derart relativ zu dem Objekt angeord- 
nei ist, dass in der Grddicnlcmiiatrix fur jeden Freiheitsgrad 
jeweils fur mindestens einen aufgenommenen Messdaten 
ein Gradienten-Betragswert enthaiten ist. 

Damit die in der Gradientenmairix im Rahmen der Rege- 
lung der Vorhaiteposition auch verarbeitet werden konnen, 
und zu einem zuverlassigen Ergebnis fuhren, wird vorge- 
schlagen, dass der oder jeder Sensor derart relativ zu dem 
Objekt angeordnet ist, dass die Gradienten-Betragswerte in 
der Gradientenmatrix signifikant sind. Man spricht von si- 
gnifikanten Gradienten-Betragswerten, wenn diese von dem 
Messrauschen der aufgenommenen Messdaten unterscheid- 
bar sind. Die Gradienten-Betragswerte sind bspw. unter- 
scheidbar, wenn sie etwa doppelt so groB sind wie das Mess- 
rauschen der aufgenommenen Messdaten. Falls die Gra- 
dientenstarke nicht ausreichend groB ist, wird der entspre- 
chende Gradienten-Betragswert als nicht vorhanden gewer- 
tet. Die Gradienten-Betragswerte in der Gradientenmatrix 
sind vorzugsweise in etwa mindestens dreimal so groB wie 
das Messrauschen. 

Die Kriterien der Monotonie der Folge der Messdaten, 
der Beobachtbarkeit der Regelung und der Gradientenstarke 
konnen durch die Position der Sensoren relativ zu dem Ma- 
nipulator beeinflusst werden. Der genaue Bezug der Senso- 
ren zu dem Manipulator ist allerdings von unteigeordneler 
Bedeutung, solange die o. g. Kriterien erfullt sind. Der Be- 
zug der Sensoren zu dem Manipulator wird wahrend der 
Trainingsphase erfasst und uber die aufgenonmienen und 
abgespeicherten Messdaten in der Regelung berucksichtigt. 

GemaB einer bevorzugten AusfUhrungsform der vorlie- 
genden Erfindung wird vorgeschlagen, dass der oder jeder 
Sensor als ein opdscher Sensor, insbesondere als eine CCD- 
Kamera, ausgebildet ist. Mittels CCD-Kam^as kann ein 
Objekt auf vielfaltige Weise charakterisiert werden. Es ist 
denkbar, dass die Messdaten bei als CCD-Kameras ausge- 
bildeten Sensoren als Abstande zwischen den Sensoren und 
dem Objekt, als Pixel auf dem CCD-Chip -o. a. ausgebildet 
sind. CCD-Kameras haben zudem den Vorteil, dass ihr 
Blickfeld zum Ausrichten der Sensoren relativ zu dem Ob- 
jekt auf einem Bildschirm dargestellt werden kann. Das er- 
leichtert die Ausrichtung der Sensoren erheblich. 

Ein bevorzugtes Ausfuhrungsbeispiel der vorliegenden 
Erfindung wird im Folgenden anhand der 2^ichnung naher 
erlaulert. Es zeigt: 

Fig. 1 ein erfindungsgemaBes Handhabungsgerat gemaB 
einer bevorzugten AusfUhrungsform; 

Fig. 2 den Manipulator des Handhabungsgerats aus Fig. 1 
im Ausschnitt; und 

Fig. 3 eine Verfahrbahn eines erfindungsgemaBen Hand- 
habungsgerats. 

In Fig. 1 ist ein erfindungsgemaBes Handhabungsgerat in 
seiner Gesamtheit mit dem Bezugszeichen 1 gekennzeich- 
nei. Das Handhabungsgerat 1 weist einen Manipulator 2 auf, 
der in sechs Freiheitsgraden (x, y, z, a, b, c) bewegbar ist. 
Das Handhabungsgerat 1 ist bspw. als ein Industrie-Roboter 
ausgebildet, dessen Manipulator 2 bspw. als ein beliebiges 
Werkzeug oder als ein Messkopf zur Aufnahme beliebiger 
MessgroBen (Temperatur, Abstand, etc.) ausgebildet ist. 

Damit der Manipulator 2 die ihm zugedachte Aufgabe er- 
fiillen kann, muss er in eine definierte Vorhaiteposition (vgl. 
Fig. 2) relativ zu einem Objekt 3 gebrachl werden. Unter 
dem BegrifF Vorhaiteposition wird gemaB dem vorliegenden 
Patent auch die Ausrichtung des Manipulators 2 relativ zu 
dem Objekt 3 verstanden. Die Erfindung schlagt ein Verfah- 
ren zur Regelung der Vorhaiteposition vor. Das erfindungs- 
gemaBe Verfahren kann nicht nur fiir jede Art von Pick-and- 
place-Anwendungen, sondem auch fiir Anwendungen, bei 
denen einem bestimmten Linienverlauf gefolgt werden 
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muss, bspw. zum SchweiBen, Kleben oder Abdichten von 
Kantcn. cingcsctzt wcrdcn. 

GemaB dem vorliegenden Ausfuhrungsbeispiel soli ein 
Schiebedach 4 eines Kraftfahrzeugs von dem Manipulator 2 
ergriffen und in eine entsprechende Offnung (Objekt 3) im 5 
Dach 5 der Karosserie des Kraftfahrzeugs eingesetzt wer- 
den. Der Manipulator 2 ist als ein Saugnapf zum Greifen des 
Schiebedachs 4 ausgebildet. Die Vorhalteposition ist erne 
Position oberhalb der Offnung, von der aus das Schiebedach 
4 in ciner geradlinigen, senkrcchten Bewegung nach unten lo 
in die Offnung bewegt werden kann. 

Das Handhabungsgerat 1 weist eine interne Steuerungs- 
einrichtung 6 auf. Auf der Steuerungscinrichtung 6 ist ein 
Steuerungsprogramm lauffahig, durch das der Manipulator 
2 entlang einer programmierten Verfahrbahn (vgl. Fig. 3) in 15 
die Vorhalteposition bewegt werden kann. Wenn das Objekt 
3, im vorliegenden Ausfuhrungsbeispiel die Ofiftiung im 
Dach 5 der Karosserie des Kraftfahrzeugs, stete an derselben 
Position angeordnet ist, reicht eine solche Sleuerung der 
Verfahrbahn bis zur Vorhalteposition voUkommen aus. Falls 20 
die Position des Objekte 3 jedoch gewissen Schwankungen 
unterworfen ist, kann durch eine Steuerung alleine nicht 
mehr sichergestellt werden, dass eine bestimmte Vorhalt- 
eposition des Manipulators 2 relativ zu dem Objekt 3 stets 
mit der erforderlichen Genauigkeit eingenommen wird. 25 
Schwankungen des Objekts 3 komien sich bspw. aufgrund 
von Ungenauigkeiten bei der Positionierung der Karosserie 
relativ zu dem Handhabungsgerat 1 oder aufgrund der Be- 
wegung der Karosserie des Kraftfahrzeugs auf einer Ferti- 
gungsstraBe ergeben. , ^ 

Urn sicherzustellen, dass die Vorhalteposition des Mani- 
pulators 2 relativ zu dem Objekt 3 auch bei Schwankungen 
der Position des Objekts 3 stets mit der geforderten Genau- 
igkeit eingenommen wird, wird in solchen Fallen die 
halteposition des Manipulators 2 relativ zu dem Objekt 3 ge- 35 
regelt. Aus dem Stand der Technik sind mehrere Verfahren 
zur Regelung der Vorhalteposition des Manipulators 2 be- 
kannt. Diese Verfahren sind jedoch sehr arbeits- und zeitauf- 

wendig. , 

Das erfindungsgemaBe Verfahren zur Regelung der Vor- 40 
halteposition des Manipulators 2 weist verschiedene Merk- 
male zur Beschleunigung und Vereinfachung der Regelung 
auf. Das Verfahren ist auf einer extemen Regelungseinrich- 
tung 7 implementiert (vgl. Fig. 1), Die Regelungseinrich- 
tung 7 ist als ein herkommlicher Personal-Computer (PC) 45 
Oder Industrie-PC ausgebildet. Auf der Regelungseinrich- 
tung 7 ist ein Regelungsprogramm, das in einer herkommli- 
chen Programmiersprache programmiert ist, lauffahig. In 
Fig. 1 ist die Regelungseinrichtung 7 als von dem Handha- 
bungsgerat 1 getrennt ausgebildet. Es ist jedoch auch denk- 50 
bar, dass die Regelungseinrichtung 7 in das Handhabungs- 
gerkt 1 integriert ist. Das Steuerungsprogramm der Steue- 
rungscinrichtung 6 ist in einer proprietaren, nur auf der 
Steuerungscinrichtung 6 dieses Handhabungsgerats 1 lauf- 
fahigen Programmiersprache programmiert. Das Steue- 55 
rungsprograimn weist an bestimmten Stellen Programmier- 
befehle (Aufrufbefehle, Ruckholbefehle) auf, um das Rege- 
lungsprogramm der extemen Regelungsvorrichtung 7 von 
dem Steuerungsprogranun aus aufzurufen bzw. um von dem 
Regelungsprogramm wieder zu dem Steuerungsprogramm 60 
zuriickzukehren. Zwischen der Steuerungscinrichtung 6 und 
der Regelungseinrichtung 7 ist eine Datenleitung 8 zum 
Austausch von Daten vorgesehen. 

In Fig. 2 ist zu erkennen, dass an dem Manipulator 2 yier 
als CCD-Kameras ausgebildete Sensoren 9 angeordnet sind. 65 
Durch die Sensoren 9 werden die Verlaufe der Kanten 10 in 
Relation zu dem Manipulator 2 gesetzt. Dazu werden Mess- 
daten, die im vorUegenden Ausfuhrungsbeispiel als Pixel- 



werte der CCD-Chips der Sensoren 9 ausgebildet sind, auf- 
gcnoiniiicn und in Messvcklorcn gcspeichcrl. 

Das erfindungsgemaBe Verfahren zur Regelung der Vor- 
halteposition des Manipulators 2 relativ zu dem Objekt 3 
weist drei unlerschiedliche Betriebszustande auf. In einem 
ersten Betriebszustand, dem sog. Record-Mode, wird die 
Verfahrbahn A bis B (vgl. Fig. 3) zu einer Vorhalteposition 
hin und von der Vorhalteposition weg von dem Steuerungs- 
programm der Steuerungscinrichtung 6 gesteuert abgefah- 
rcn. In dem Bereich der Verfahrbahn zwischen den Punkten 
C und D liegt ein fiir die Regelung interessanler Bereich mit 
einem oder mehreren Vorhaltepositionen des Manipulators 
2, die relativ zu dem Objekt 3 geregelt werden soUen. Wenn 
der Manipulator 2 beim Abfahren der Verfahrbahn den 
Punkt C erreicht hat, wird das Regelungsprogramm der Re- 
gelungseinrichtung 7 aufgerufen. Wahrend des gesteuerten 
Abfahrens der Verfahrbahn von dem Punkt C bis D werden 
dann einer oder mehrere Punkte von dem Regelungspro- 
gramm aufgenommen und gespeichert. Wenn die Verfahr- 
bahn den Punkt D erreicht hat, wird das Regelungspro- 
gramm beendet. Damit ist der Record-Mode beendet. Auf 
die gespeicherten Punkte der Verfahrbahn wird dann in ei- 
nem dritten BeUdebszustand der Regelung zugegriflFen, 

In einem zweiten Betriebszustand, dem sog. Parameter- 
Mode, fahrt der Manipulator 2 von dem Steuerungspro- 
gramm gesteuert die Verfahrbahn von dem Punkt A zu dem 
Punkt C ab. Wenn die Verfahrbahn den Punkt C erreicht hat, 
wird das Regelungsprogramm aufgerufen, und die Steue- 
rung des Manipulators 2 wird von dem Steuerungspro- 
gramm an das Regelungsprogranun abgegeben. Das Rege- 
lungsprogramm fahrt die gespeicherte Verfahrbahn zwi- 
schen den Punkten C und D ab. Auf der Verfahrbahn werden 
diejenigen Vorhaltepositionen angefahren, die relativ zu 
dem Objekt geregelt werden soUen, und fur jede Vorhalt- 
eposition wird eine TVainingsphase durchlaufen. Wenn die 
von dem Regelungsprogramm gesteuerte Verfahrbahn den 
Punkt D erreicht hat, wird das Regelungsprogramm beendet 
und die Steuerung des Manipulators 2 entlang der Verfahr- 
bahn wieder an das Steuerungsprogramm zuriickgegeben. 
Der Manipulator 2 fahrt dann von dem Steuerungspro- 
gramm gesteuert die restliche Verfahrbahn von dem Punkt D 
bis B ab. Dainit ist der Parameter-Mode beendet. 

Fiir jede Vorhalteposition, die relativ zu dem Objekt 3 ge- 
regelt werden soU, wird eine TVainingsphase durchgefuhrt. 
Dazu wird zunachst die Soil- Vorhalteposition mit dem Mar 
nipulator 2 angefahren, und von den Sensoren 9 werden die 
Werte von 32 Messdaten, durch die die Soil- Vorhaltepos- 
ition charakterisiert ist, aufgenommen und in einem Soll- 
Messvektor y_soU gespeichert. Der Soll-Messvektor y^soU 
hat somit die Dimension 32 X 1 (32 Messdaten x 1 Wert). 
AnschlieBend wurd der Manipulator 2 nacheinander um je- 
den der sechs Freiheitsgrade in fiinf Vorhaltepositionen in 
der einen Richtung der Soil- Vorhalteposition und in fiinf 
Vorhaltepositionen in der anderen Richtung der Soil- Vor- 
halteposition bewegt. In jeder Vorhalteposition werden die 
entsprechenden Werte der 32 Messdaten aufgenommen und 
in Messvektoren gespeichert. Aus den zehn Messvektoren 
und dem Soll-Messvektor y_soU wird dann fUr jeden der 
sechs Freiheitsgrade der Betrag des Gradienten eines be- 
stimmten Messdatums berechnet und in einer Gradienten- 
matrix C abgespeichert. Die Gradientenmatrix C hat somit 
die Dimension 32 x 6 (32 Messdaten X 6 Freiheitsgrade). 
Fiir jeden der zu regelnden Vorhaltepositionen erhalt man 
somit einen Soll-Messvektor y_soll und die Gradientenma- 
tiix C. 

In einem dritten Betriebszustand, dem sog. OperaUon- 
Mode, fahrt der Manipulator 2 von dem Steuerungspro- 
gramm gesteuert die Verfahrbahn von dem Punkt A zu dem 
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Punkl C ab. Wenn die Verfahrbahn den Punkt C erreicht hat, 
wird das Rcgelungsprograinin aufgcrufen, und die Stcuc- 
rung des Manipulators 2 wird von dem Steuerungspro- 
gramm an das Regelungsprogramm abgegeben. Das Rege- 
lungsprogramm fahrt die gespeicherte Verfahrbahn zwi- 5 
schen den P*unkten C und D ab. Die gespeicherten Punkle 
der Verfahrbahn erlauben eine vorausschauende Regelung 
der Vorhaltepunkle auf der Verfahrbahn, was bei gleicher 
oder sogar hoherer Genauigkeit eine wesentlich hohere Ver- 
fahrbahngeschwindigkeit als bei den aus dein Stand der 10 
Technik bekannten Verfahren zum Regein der Vorhaltepos- 
ition eines Manipulators ermoglicht. 

In deiii Bercich der Verfahrbahn zwischen den Punkten E 
und F liegt ein fiir die Regelung interessanter Bereich mit ei- 
nem oder mehreren Vorhaltepositionen des Manipulators 2, 15 
die reladv zu dem Objekt 3 geregelt werden sollen. Sobald 
die Verfahrbahn den Punkt E erreicht hat, erfolgt eine Rege- 
lung der Vorhalteposition auf der Verfahrbahn. Im Rahmen 
der Regelung der Vorhalteposition werden von den Senso- 
ren 9 zunachst in der momentanen 1st- Vorhalteposition die 20 
entsprechenden Werte der Messdaten aufgenommen und in 
einem Ist-Messvektor y_ist gespeichert. Der Ist-Messvektor 
y_ist hat ebenfalls die Dimension 32 x 1 (32 Messdaten x 1 
Wert). Aus der Differenz des S oil-Mess vek tors und des Ist- 
Messvektors wird ein DifFerenz-Messvektor D_y gebildet 25 
(D_y - y soli - y_ist). Der DifFeienz-Messvektor D_y hat 
ebenfalls die Dimension 32 x 1. Dann wird der Kehrwert 
der Gradientenmatrix C berechnet und wahlweise abgespei- 
cheit. Aus dem I^xxlukt des Kehrwerts des Gradientenvek- 
tors C und des Differenz-Messvektors D_y wird ein Korrek- 30 
turvektor D_x ermittelt, der ebenfalls die Dimension 32 x 1 
hat Es ist jedoch auch denkbar, dass der Korrekturvektor 
D_x mittels eines anderen geeigneten Verfahrens, bspw. 
durch den Einsatz eines sequentiellen Kalmanfilters, ermit- 
telt wird. 35 

Ein Teil des Korrekturvektors D_x, vorzugsweise etwa 
10% des Korrekturvektors D_x, wird zur Korrektur der Ist- 
Vorhalteposition des Manipulators 2 herangezogen. In der 
neuen Ist- Vorhalteposition werden emeut die entsprechen- 
den Werte der Messdaten aufgenommen und in einem Ist- 40 
Messvektor y_ist gespeichert. Wie oben bereits beschrieben 
wird emeut ein Korrekturvektor D_x berechnet und die Ist- 
Vorhalteposition in Abhangigkeit von dem Korrekturvektor 
D_x korrigiert. Die Korrektur der Ist- Vorhalteposition wird 
so lange wiederholt, bis die einzelnen Werte des Korrektur- 45 
vektors D_x ein bestimmtes Abbruchkriterium erfiillt ha- 
ben, d. h. bis der Manipulator 2 auf die Soil- Vorhaltepos- 
ition geregelt ist. 
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1. Verfahren zur Regelung der Vorhalteposition eines 
in mehreren Freiheitsgraden bewegbaren Manipulators 
(2) eines Handhabungsgerats (1) relativ zu einem Ob- 
jekt (3) entiang einer Verfahrbahn, dadurch gekenn- 55 
zeichnet, dass mehrere Punkte zumindest eines Teils 
der Ist- Verfahrbahn gespeichert sind und fur eine vor- 
ausschauende Regelung der Vorhalteposition des Ma- 
nipulators (2) entiang dieses Teils der Verfahrbahn her- 
angezogen werden. 60 

2. Verfahren nach Anspruch 1, dadurch gekennzeich- 
net, dass die Ist- Verfahrbahn des Manipulators (2) vor 
der Regelung der Vorhalteposition abgefahren wird 
und dabei die Punkte zumindest eines Teils der Ist- Ver- 
fahrbahn aufgenommen und abgespeichert werden. 65 

3. Verfahren nach Anspruch 2, dadurch gekennzeich- 
nct, dass die Ist- Verfahrbahn von dem Manipulator (2) 
vor der Regelung der Vorhalteposition von einer inter- 



nen Steuerungseinrichtung (6) des Handhabungsgerats 

(1) gesteuert abgefahren wird. 

4. Verfahren nach Anspruch 2 oder 3, dadurch gekenn- 
zeichnet, dass die P*unkte zumindest eines Teils der Ist- 
Verfahrbahn von einer extemen Regelungseinrichtung 
(7) aufgenommen und abgespeichert werden. 

5. Verfahren nach Anspruch 3 und 4, dadurch gekenn- 
zeichnet, dass die exteme Regelungseinrichtung (7) 
von der intemen Steuerungseinrichtung (6) aufgerufen 
wird. 

6. Verfahren zur Regelung der Vorhalteposition eines 
in mehreren Freiheitsgraden bewegbaren Manipulators 

(2) eines Handhabungsgerats (1) relativ zu einem Ob- 
jekt (3) entiang einer Verfahrbahn, insbesondere nach 
einem der Anspriiche 1 bis 5, dadurch gekennzeichnet, 
dass die Soil- Vorhalteposition des Manipulators (2) vor 
der Regelung der Vorhalteposition angefahren wird, 
wahrend einer Veranderung der Soli- Vorhalteposition 
um jeweils einen Freiheitsgrad Messdaten, durch die 
die Vorhalteposition des Manipulators (2) charakteri- 
siert ist, aufgenommen und gespeichert werden und die 
Regelung der Vorhalteposition in Abhangigkeit von 
den Messdaten durchgefuhrt wird. 

7. Verfahren nach Anspruch 6, dadurch gekennzeich- 
net, dass vor der Regelung der Vorhalteposition 

- die SoU- Vorhalteposition angefahren wird, 

- ein Soil-Mess vektor (y_soll) mit den Messda- 
ten aufgenommen wird, 

- fUr jeden Freiheitsgrad der Manipulator (2) des 
Handhabungsgerats (1) aus der Soil- Vorhaltepos- 
ition heraus in mehr^e. Vorhaltepositionen be- 
wegt und in jeder Vorhalteposition ein Messvektor 
aufgenommen wird, 

- fiir jeden Freiheitsgrad ftir dieselben Messdaten 
der Messvektoren der Betrag des Gradienten er- 
mittelt und in ein^ Gradientenmatrix (C) gespei- 
chert wird, und im Rahmen der Regelung der Vor- 
halteposition 

- ein Korrekturvektor (D_x) aus der Multiplika- 
tion des Kehrwerts der Gradientenmatrix (C) mit 
der Differenz des Soil-Mess vektors (y_soll) und 
eines Ist-Messvektors (y_ist) in der Ist- Vorhalt- 
eposition des Manipulators (2) oder anhand eines 
anderen geeigneten Verfahrens ermittelt wird und 

- die Vorhalteposition in Abhangigkeit von dem 
Korrekturvektor (D_x) geregelt wird. 

8. Verfahren nach Anspruch 7, dadurch gekennzeich- 
net, dass die Ist- Vorhalteposition des Manipulators (2) 
im Rahmen der Regelung der Vorhalteposition um ei- 
nen Bruchteil des Korrekturvektors (D.x) korrigiert 
wird und anschlieBend der Ist-Messvektor (y_ist) in der 
korrigierten Ist- Vorhalteposition und daraus der Kor- 
rekturvektor (D_x) emeut ermittelt wird. 

9. Verfahren nach Anspruch 8, dadurch gekennzeich- 
net, dass die Regelung der Vorhalteposition abgebro- 
chcn wird, wenn jedes der Elemente des Korrekturvek- 
tors (p_x) kleiner als ein Abbruchkriterium ist. 

10. Verfahren nach Anspruch 8 oder 9, dadurch ge- 
kennzeichnet, dass fiir jeden Freiheitsgrad von der 
Soil- Vorhalteposition aus mindestens zwei Messvekto- 
ren in jede Richtung aufgenommen werden. 

11. Verfahren nach Anspruch 10, dadurch gekenn- 
zeichnet, dass fiir jeden Freiheitsgrad von der Soil- Vor- 
halteposition aus fiinf Messvektoren in jede Richtung 
aufgenommen werden. 

12. Verfahren nach einem der Anspriiche 1 bis 5, da- 
durch gekennzeichnet, dass die Messvektoren zusam- 
men mindestens sechs Messdaten enthalten, damit die 
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Position und Ausrichtung des Manipulators (2) relativ 
zu dctii Objckt (3) iin drcidimcnsionalcn Rauin charak- 

terisiert ist. 

13. Verfahren nach Anspruch 12, dadurch gekenn- 
zeichnet, dass die Messvektoren jeweils 32 Messdaten 5 
enthalten. 

14. Vorrichtung zur Regelung der Vorhalteposition ei- 
nes in mehreren Freiheitsgraden bewegbaren Manipu- 
lators (2) eines Handhabungsgerats (1) relativ zu einem 
Objekt (3) entlang einer Verfahrbahn, dadurch gckenn- lo 
zeichnet, dass die Vorrichtung Mittel zur Durchfuhrung 
des Verfahrens nach einem der Anspriiche 1 bis 13 auf- 
weist. 

15. Handhabungsgerat (1) mit einem in mehreren Frei- 
heitsgraden bewegbaren Manipulator (2), dessen Vor- 15 
halteposition relativ zu einem Objekt (3) regelbar ist, 
dadurch gekennzeichnet, dass das Handhabungsgerat 
(9) Mittel zur Durchfuhrung des Verfahrens nach ei- 
nem der Anspriiche 1 bis 13 aufweist. 

16. Handhabungsgerat (1) nach Anspruch 15, dadurch 20 
gekennzeichnet, dass an dem Manipulator (2) des 
Handhabungsgerats (1) zur Ermittlung der Ist- Vorhalt- 
eposition des Manipulators (2) relativ zu dem Objekt 
(3) mindest^s ein Sensor (9) befestigt ist. 

17. Handhabungsgerat (1) nach Anspruch 16, dadurch 25 
gekennzeichnet, dass der oder jeder Sensor (9) derart 
relativ zu dem Objekt (3) angeordnet ist, dass die Folge 
der Messdaten der fiir einen Freiheitsgrad aufgenom- 
menen Messvektoren strong monoton ist. 

18. Handhabungsgerat (1) nach Anspruch 17, dadurch 30 
gekennzeichnet, dass in der Gradientenmatrix (C) fiir 
jeden Freiheitsgrad jeweils fiir mindestens ein aufge- 
nommenes Messdatum ein Gradienten-Betragswert 
enthalten ist. 

19. Handhabungsgerat (1) nach Anspruch 18, dadurch 35 
gekennzeichnet, dass die Gradienten-Betragswerte in 
der Gradientenmatrix (C) signifikant sind. 

20. Handhabungsgerat (1) nach einem der Anspriiche 
15 bis 19, dadurch gekennzeichnet, dass der oder jeder 
Sensor (9) als ein optischer Sensor ausgebildet ist. 40 

21. Handhabungsgerat (1) nach Anspruch 20, dadurch 
gekennzeichnet, dass der oder jeder Sensor (9) als eine 
CCD-Kamera ausgebildet ist. 
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Abstract of DEI 9930087 

Procedure for controlling the position of a handling device (1) manipulator (2) relative to an object along 
a movement path in which a number of points of a part of the actual path are stored in memory and are 
used for forward path planning. Independent claims are made for a device using the above procedure 
and a handling device using the procedure. 
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